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^ ■ SUMMARY 

f— I , This paper considers a novel problem of how to choose an appropriate geometry for a group of agents with 

I only shape constraints but with a flexible scale. Instead of assigning the formation system with a specific 

geometry, here the only requirement on the desired geometry is a shape without any location, rotation 
and, most importantly, scale constraints. Optimal rigid transformation between two different geometries 
1—' , is discussed with especial focus on the scaling operation, and the cooperative performance of the system 

is evaluated by what we call the geometries degrees of similarity (DOS) with respect to the desired shape 
during the entire convergence process. The design of the scale when measuring the DOS is discussed from 
constant value and time-varying function perspectives respectively. Fixed structured nonlinear control laws 
that are functions on the scale are developed to guarantee the exponential convergence of the system to the 
assigned shape. Our research is originated from a three-agent formation system and is further extended to 
C/3 ' multiple (n > 3) agents by defining a triangular complement graph. Simulations demonstrate that formation 

O \ system with the time-varying scale function outperforms the one with an arbitrary constant scale, and the 

relationship between underlying topology and the system performance is further discussed based on the 
simulation observations. Moveover, the control scheme is applied to bearing-only sensor-target localization 
s.^ to show its application potentials. Copyright @ 2010 John Wiley & Sons, Ltd. 
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^ 1. INTRODUCTION 

A group of agents working together in formation is seen in various field applications including, 
^ ' for example, spacecrafts exploring the deep space, underwater vehicles mapping out oceanbed and 

\^ , unmanned aerial vehicles detecting an unknown territory. Studies concerning this subject focus 

primarily on the stability of the formation systems where there are three well-known methodologies, 
namely distance-based formation control laws[l, 2], position-based control laws[3, 4, 5], and 
very recently, angle-based algorithms[6, 7]. Meanwhile, it is well known that the stability and 
the performance of the formation systems depend highly on the underlying communication 
topologies. This fact leads to the exploration of information flow laws among agents[8, 9] and 
the communication topology properties of the formation systems[10, 11]. Consequently there are 
control algorithms that aim to deal with various network dynamics[9, 12, 13]. 

Current research on formation control relies on the assumption that the desired geometry is 
specified, fixed, and known a priori either in a global coordinate or a local one. Inspired by the 
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fact that V-shaped formation provides birds with more aerodynamical and visual advantages than 
other types of flight in flocks[14], it is reasonable to conjecture that the geometry formed by the 
group of agents is closely related to the behaviors of the formation system. Thus with all those 
abundant results under the determined assumptions, we are now ready to move on to the next stage, 
that is, to consider situations where the only concern of the final state is the shape of the system 
rather than some specific geometry. In other words, this research considers the scenario where the 
requirement on the desired formation is its geometrical information without any constraints on its 
location, rotation and scale. 

This particular problem arises in angle-based emitter-target localization that emerged in 
1950s[15]. It were proved in [16], [17] and [18] that there were a set of geometries such as equilateral 
triangles in which sensors could provide the most accurate estimations of the target position. When 
the distances between sensors to the target are sufficiently larger than the ones between sensors, the 
shape formed by the group of agents is then the major concern instead of a specific geometry. It 
can be further verified that the geometry with a higher degree of similarity (DOS) (please refer to 
Section 3 for its definition) to the optimal shape can provide better target location estimation. Thus 
in order to improve the accuracy of measurements on the target before sensors reaching the desired 
shape so as to allow more time for strategy making, a formation system that maintains a high DOS 
to the optimal shape during convergence is more preferable than simply focusing on the final shape. 

However, despite of the potential advantages brought by the geometrical resemblance, optimal 
formation control with only shape constraints has not yet received enough attentions. To our best 
knowledge, there are only a few literatures that are related to this topic. One was reported in [19] 
where the authors focused on finding the optimal scale of the prescribed shape for a set of robots 
such that the total distance they traveled was minimized. However, robot control during the process 
was ignored and thus the group of robots did not exhibit any cooperative behaviors. In another 
work[20] on optimal relative formation control of three wheeled robots, the cost function was the 
kinematic energy sum of the three robots. By choosing a robot as the rotation center, the optimal 
relative positions of robots were designed. Shape control irrespective of any objectives is seen 
in a small number of literatures. By modeling each agent as a double integrator, reference [21] 
considered shape control on the projected orthogonal reference frame, and very recently, reference 
[7] proposed a distributed algorithm that stabilized three agents in the assigned shape. However, 
those research ignored the performance during the convergence process and thus are not favorable 
to tasks such as sensor-target localization. 

To this end, this paper aims to explore the novel topic of formation control under only shape 
constraints, and exploit the design of scales that provide the optimal rigid transformation(rotation, 
translation and scaling operations) between two different geometries. The objective is to minimize 
a cost function that integrates the difference between the geometry and the desired shape over the 
entitle convergence process. Although there are quite a few discussions on the optimal formation 
control, the objectives are normally fuel consumption[22], traveling length and time[23]. Fixed 
structured nonlinear control laws on the edge state and the pending scale are proposed. When 
choosing the appropriate scale of the final geometry so as to minimize the cost value, two situations 
are considered one of which is to determine an optimal value a priori and set it constant during the 
entire process. Another more intelligent method is to design a function named the scale function 
that adjusts the scale online. 

Here is an outline of the paper: Section II contains the notations and definitions that are used in 
the paper. A nonlinear control law, which is the starting point of this research, is introduced in this 
section as well. In Section III, the difference between two geometries is defined and further the cost 
function is proposed which represents the geometrical performance during formation attainment. 
Design of a constant scale is discussed in Section IV, and in Section V a scale function is proposed 
that further reduces the minimum from the previous section. By defining a triangular complement 
graph of the minimally rigid graph, the algorithm applies to multiple (n > 3) agents case as well. 
In order to broaden the application of the nonlinear algorithm to situations with determined final 
geometries, controllability of the system is discussed by adding a positive weight factor to the 
nonlinear control law. Moreover, applications of the proposed control schema in sensor-target 
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localization are presented in Section VI. Section VII presents extensive experimental simulations 
that verify the effectiveness of the algorithm and show its application potentials. Conclusions are 
made in Section VIII. 



2. PRELIMINARY 

Positive real numbers are denoted by and a matrix of size m x n is denoted by M™^" where 
when n = 1, it is always abbreviated by M™. The (block) diagonal matrix of vector v is denoted 
by diag(i;i) with (vector) Vi being the ith (block) diagonal entry. Sometimes we may also use 
diag(ui, . . . , Vn) instead. 

For an undirected graph G = {V, E), the numbers of edges and vertices are denoted by \E\ and 
|y| respectively. Vertex i is the neighbor of vertex j, denoted by i ^ j, if they are connected by an 
edge in E. Edge i is the neighbor of edge j if they share a vertex. The neighbor sets of vertex i 
and edge i are denoted by Mv{i) and Me{i) respectively. The minimal distance between vertex i and 
vertex j is the minimal number of edges in E that are needed to have them connected. 

Throughout the paper, we focus on 2D formations on a plane, and we do not consider a system 
where agents are collinear or coincided, that is 

Assumption 2.1 

The initial positions and the desired positions of agents in a formation system are non-collinear. 

For graph G, if we label the nodes in V from 1 to \V\ and the edges in E from I to \E\, the 
representation of G is a vector z whose ith entry Zi € is the position of the ith node. Given G, 
if we assign an arbitrary direction on each edge, then the representation z uniquely determines an 
edge vector e where e corresponds to the zth directed edge in E, and e is called a relative 
representation or a geometry of G. Note that in this paper, a geometry is associated with a graph, 
which is a more strict definition than that of a polygon. Given a graph G, the distance between 
two representations zi and Z2 is (i(zi,z2) = maxig\/ \\zn — Z2i\\- The representation z is further 
called a realization of G if all the distances between neighboring vertexes in G are compatible, and 
consequentially e is the relative realization of G. All possible realizations of G form a vector space 
denoted by Z, and consequently a link/edge space E. A formation system is a group of agents that 
communicate over G and whose deployment is depicted by a realization of G. 

A realization z of G in two dimensions is rigid if there exists e > such that for all realizations 
z' e Z that satisfy \\z[ — z^-|| = \\zi — Vi ~ j and d(z, z') < e, there holds \\z[ — = \\zi — 
^j IIj^*; J S ^- A rigid graph is further minimally rigid if no single edge can be removed without 
losing rigidity. Finally, a globally rigid graph G is a graph where ||z- — z^-|| = ||zi — Zj||, Vi, j e V 
holds for an arbitrary e > 0. More rigorous definitions could be found, for example, in [3, 10]. 

Given a graph G and two realizations z^ and z, z is similar to z^ if 

"n ^ = "n 7-yi,m^V (1) 

\\zi-Z2\\ Wzdt-Zd^W 

and consequently, e and are similar geometries. Without lose of generality, assume node 1 in 
both realizations is deployed at the origin. Then it is necessary that 

zd^ = kO{9)zi (2) 

where A; e M and 0{6) is a rotation transformation through angle 9. Fig. 1(a) and Fig. 1(b) give 
examples showing similar and dissimilar geometries. Although the two triangles in Fig. 1(b) are 
similar ones in the usual sense of plane geometry, in our case this is no longer true due to the 
mismatching of indexed nodes. 

Given a relative realization of G, a shape vector S{ed) generated from is determined by 

S{ed)=[si S2 ■■■ Si]^eIR',/ = |£;|,s, eM+ 

where Si = ||edj|. In most of cases, we will use S for abbreviation. The set {e\S} consists of all 
similar geometries to S over the same graph. Fig. 2 gives an explanation on the relationships between 
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(a) Similar geometries 
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(b) Dissimilar geometries 
Figure 1 . Geometries with ordered vertexes 



4 1 
(c) Dissimilai' geometries 







Shape vector 




{e\S(e,)} 



Figure 2. The relationship between the shape and the geometry 



those three notations. Elements are uniquely determined along the arrows and the reverse is not true. 
In fact, given a shape vector S, it uniquely determines a shape or a geometry if and only if the 
underlying graph is a globally rigid one[ 10]. 

Due to the nature of the algorithms introduced in this paper and for convenience, the scale of a 
geometry in {elS*} with respect to S is 



s = 



ei 



2sl 



which is identical to all edges. 

The incidence matrix is frequently used to describe the structure of a directed graph. For an 
undirected graph, by assigning each edge an arbitrary direction, we have the oriented incidence 
matrix as seen, for example, in [24]. 

Definition 2.1 (Oriented Incidence Matrix) 

For an undirected graph G = {V, E), each edge is assigned with a random direction to generate a 
directed graph G = {V,E). The oriented incidence matrix of G, denoted by H{G), is a matrix of 
dimension \E\ x \V\ whose ith row corresponds to the ith edge in E with entries 

1 , Bi sinks at j 
— 1 ,ei leaves j 
, others 

Lemma 2. 1 

The oriented incidence matrix H{G) has rank n — 1 when G is connected. 

By introducing the expended incidence matrix H ~ H ® I2, where ® is the Kronecker product, 
the edge space E can then be considered as a codomain of H from the vector space Z: 

e = iJz 

where z G Z and e e E. Thus we have e e ImH. 
Further we define a rigidity function[3] (also known as the edge function[25]) 



and the rigidity matrix is further defined as 

O'L 

with A(e) = diag(efc), Cfc e M^. For a rigid graph, ranki?(e) = 2\E\ - 3. 



(3) 
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Lemma 2.2 ([25]) 

For a desired relative realization over G — {V, E) and the vector d e M'^' with dk = [\\\edk \W 
by choosing the potential function 

\E\ 

V{e)=Y,^{\\ekr~2duf (4) 
fe=i 

the control law 

i^u = -H'^[dV{e)/deY (5) 
is an inverse optimal solution to the optimization problem 

minJ(eo,u) = - / \\R{ef[r{e) - d]f + \\ufdT 
2 Jo 

s.t e = Hu, Go = e(0) G ImH (6) 
and the formation system converges to the largest invariant set 

le = {e e ImH : V{e) < ^(eo), \\R{ef[r{e) - d]|| = 0} (7) 

The proof of the lemma is based on the Hamilton-Jacobi-Bellman (HJB) equation and Lyapunov 
Theory. For details please refer to [25]. 

Algorithm (5) requires that each agent has the knowledge of the global coordinates of its 
neighbors. This requirement is also assumed to be true in our research. 



3. COST FUNCTION AND COOPERATIVE PERFORMANCE 

With the wide range of applications of sensor networks, the geometric characters of a group of 
sensors are sometimes crucial to the achievement of tasks, such as bearing only sensor-target 
localization, shape-constrained formation reconfiguration and obstacle avoidance. Thus it is exigent 
to propose an efficient way to distinguish two geometries. 

In image processing, especially in pattern matching, the Hausdorff distance is commonly used 
to evaluate how much do two geometries resemble each other under rigid transformation[26]. 
The problem of shape matching is to find the optimal transformation that minimizes the distance. 
Sometimes points on the edges are assigned with different weights indicating their importance to the 
shape. However, the Hausdorff distance metric is on the basis a minimization function, which is not 
favorable as an objective function. Meanwhile, at each time step, the time complexity to compute 
the Hausdorff distance for two points sets of size p and q is 0{pq). Thus another metric function is 
expected that produces intuitively reasonable results and is beneficial to optimization. 

Before we dive into the mathematical formalizations, here are two observations for determining 
the resemblance of geometries with respect to the reference/desired shape: 

i A geometry is less sensitive to perturbations on long edges 

ii A geometry is less sensitive to perturbations on edges with large included angles (0, tt) 

Fig. 3 further explains the above two observations. It is intuitive that under the same perturbation, the 
long edge bring small deformation to the geometry than that of a short edge, as the two geometries 
in Fig. 3(a). Meanwhile, apart from the lengths of edges, another profile of a shape is the vertex, 
especially those sharp vertexes, i.e., the included angle of the two edges adjacent at the vertex is 
small. 

When two geometries are similar to each other, the scale between them is the ratio of two 
corresponding edges in the geometries and is identical to all the pairs of edges. However, for two 
dissimilar geometries, there is no common ratio for any pairs of edges, thus choosing an appropriate 
scale is premise to the analysis of geometries resemblance. 
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(a) When the short edge suffer a small perturbation, the (b) When the angle included in the two edges is 
perturbed geometry various a lot w.rt. the nominal one; large(0 n), perturbations on the two edges will result in 
When the same perturbation is added to the long edge, small change to shape; When the angle is small(0 tt), 
the new geometry is quite close to the nominal one the shape is greatly affected by the same perturbations 



Figure 3. The sensitivity of a geometry 



According to the above two observations, it is obviously inappropriate to simply use the 
differences between edges lengths of the two geometries to measure how two geometries are related: 



J' 



\\r{e)-r{e')rdr 



(8) 



because J' dose not consider observation i or observation ii. 

We are interested in the resemblance of two geometries, thus under observations i and ii, the 
difference between geometry e and e' is 



(ri(e)-eri(e'))ei 



(r„(e) - er„(e'))e„ 



As one can tell, an appropriate scale 9 is key to the evaluation. In our research, the geometry is 
depicted by 2|y | — 3 directed edges rather than the coordinates of the vertexes, thus the translation 
and rotation operations are not our concems. The element (ri(e) — 9ri(e'))e,; := SviCi indicates 
that each edge in one geometry is scaled by the edge difference between the two geometries. This is 
designed to take care of observation i.b Inspired by the weighted Hausdorff distance, we introduce 
the transformation which allows two neighboring edges communicate and consequently, as 
shown in Fig. 3(b), evolve into the edges in dot lines, the lengths of which are positive monotony to 
the sharpness of the vertexes. 

Given a geometry e and a shape ^(e') , the degree of similarity (DOS) of e with respect to S is 
measured by 

dose(e,5(e')) = ||pe(e,e')||2"' (9) 



A geometry with a higher DOS to S is said to be more resemble to S. When the geometry is similar 
to S, dos0{e, e') — > oo. 

As mentioned before, by taking care of the geometries DOS during the entire convergence, 
sensors can provide reliable measurement of the target in an early stage. Thus in this research, 
the geometrical performance of a formation system is the integral of the DOS with respect to the 
desired shape during convergence: 



J(eo,u, 6) 



dosQi(e,S'(e'))rfr 



\R{e)'^[r{e)-QS]fdT 



(10) 



with S ~ [si] and Si = sf. We use instead of S due to the composition of 7'(e) in (3). Apart from 
the initial state eg and the control law u, the value of J is also a function on the scale 6. 
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(a) Performance (b) Triangle (c) New space 



Figure 4. Triangular geometry of three agents. For the definitions of DOS, please refer to (9) 

For example we consider three agents in a formation as shown in Fig. 4(b). If we set Sri = 
n - <ds, and denote L = ||i?(e)^[r(e) - <ciS]\\^, it yields 

= 11 - Sriei + 5?'2e2lP + || - 5r2e2 + (Jr^eslP + H'^'^iei - ^r^e^W"^ (H) 
The value of L is the sum of lengths of the three new vectors in Fig. 4(c). 
Remark 3.1 

A formation system with a smaller cost value (10) is considered to exhibit better 
geometrical/cooperative performance during convergence. 

By minimizing the cost function (10), the two situations as, for example, the ones in Fig. 4(a), are 
expected to be distinguished. The upper case has better geometric performance as the geometries 
during convergence have consistently high DOS with respect to the desired shape. For the bottom 
situation, although the three agents attain the desired geometry, it differs a lot from the desired 
shape during the process. In sensor networks for localization, formation system in the upper case 
may allow sensors to provide some rough estimate of the target before attaining the formation. We 
will show this later through experimental results in Section 7. 

When the underlying graph of the formation system is a minimally rigid graph, the convergence 
of J is equivalent to r(e) QS. Two forms of Q are considered in this paper, namely 9 being 
constant: Q — Sc & M'*', and 9 being a time-varying function on e: 9 = s(e) G C(E), where C is 
the set of continuous mappings. The cost functions are then written, respectively, as: 

Je(eo,u,Se)= / \\R{ef[r{e)~sJ]\\^dT (12) 
Jo 

and 

/>oo 

J„(eo,u,S(e)) = / \\R{ef[r{e) - S{e)S]\\^dT (13) 

The main concern in this research is the determination of Sc and s(e) such that the cost functions 
Jc and J„ are minimized. Note that Jc and Jy are not just quadratic expressions but a function on gq, 
u and Sc or s(e), thus minimizing the values of Jc and Jy is not trivial. Inspired by the control law 
in Lemma 2.2, in this research, we will fix the structure of the control law and focus on the design 
of the optimal scale function. 

Problem 3. 1 

Consider a formation system where each agent is modeled by 

z = u (14) 
and the underlying graph G is a minimally rigid graph. 

• Let 9 = Sc G M+, and consider the following control law on Sc and e: 

u{sc,e) = -R^{e)[r{e)-ScS]. (15) 
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Find the optimal value of Sc such that ej e {els'} where e/ is the stable realization and 

J*(eo,w(sc,e)) = min Jc(eo,ii(sc,e),Sc) (16) 

• Let Q = s(e) where s e C(E), and consider the following control law on s(e) and e: 

u(s(e), e) = -R{efM{ef[r{e) - S(e)S]. (17) 

Find the control gain A/(e) e ]]j(2ri-3)x(2»i-3) ^j^^j jj^g scale function s(e) such that e/ G 
{e|5} and 

J*(eo,w(s(e),e)) = min Jt,(eo, w(s(e), e), .5(e)) (18) 

sec(E) 

When = Sc, it is actually a matching of two fixed geometries without considering the scaling 
operation. When 6 = s(e), it turns to a matching of a geometry and a shape, which gives us more 
flexibility to optimize the geometry's DOS. 

In the remaining context of the paper, we will discuss the optimization problem (16) and (18) 
respectively. 



4. OPTIMAL FORMATIONS UNDER TIME-INVARIANT SHAPE SCALE 

System with a constant scale during the entire converging process is simple but typical. Instead 
of considering a determined final geometry at a randomly selected scale as discussed in Lemma 
2.2, here given the initial relative realization eo, we focus on finding an optimal Sc such that the 
formation system has the best cooperative performance. 
When Q ~ Sc and under the control law (15), 

n 

J,(eo, u(e, Sc), Sc) = 8 (l!e»(0)ll' " S^cS.)' (19) 
1=1 

The partial derivative of Jc with respect to Sc is 

^^Ea^"'^'"'"^'^""')'"^ ^^^^ 

^ 1=1 

By letting (20) equal to zero, it immediately yields that the optimal solution s* to problem (16) is 

n 

E(l|e.(0)|p-2s:s,)sz = (21) 
1=1 

Under Assumption 2.1, the analytical expression of the optimal scale is 

. _ Er=iHe.(0)|P^-. 

and it is obvious that s* e 

Rigidity corresponds to a unique realization of the graph only if the domain is small enough. For a 
globally unique realization, we have the idea of global rigidity [ 10] which tells that once the distances 
between any of the two neighboring agents are known, all the other distances for non-neighbors are 
uniquely determined. However, globally rigid graph is rigorous and there is no polynomial time 
algorithm to determine weather a graph is a globally rigid one or not. Meanwhile, its rigidity matrix 
is not a full rank matrix, which may brought some unexpected equilibriums in the rigidity matrix- 
based control laws. Thus we would like to focus ourselves on minimally rigid graph whose rigidity 
matrix is exactly of rank 2|y| — 3. 
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Theorem 4.1 

The formation system (14) over a minimally rigid graph converges to the largest invariant set 

le = {e e ImH : r(e) - s*5 = 0, zq G Vt^} (23) 

where 

n 

n^S) :={eo e E : ^(r,(eo) - r,(e))2 + 

i=l 

- ^""i' - ^11^' - ^"11')' < ^'^ ^ {^I^H (24) 

for a sufficiently small a if the control law is the one in (15). Furthermore, J* is obtained when 
Sc ~ s* with s* given in (22). 

Proof 

Similar to the proof of Lemma 2.2, the control law (15) for an arbitrary Sc e is a stabilization 
control law that guarantees the convergence to le- The derivation of s* indicates that (22) is the 
optimal solution to (16), which finishes the proof. □ 

Remark 4. 1 

When the underlying graph G of the shape is a minimally rigid one, a shape S dose not determines a 
geometry uniquely, and consequently r(e/) = 5*5* dose not ensures e/ e {e|5}. However, when the 
initial geometry gq of the formation system is restrained within a sufficiently small neighborhood 
Vtcr{S) of a candidate geometry, V{e) < guarantees the convergence to the desired shape. 

The optimal scale s* is, not surprisingly, uniquely determined by the initial geometry gq and the 
desired shape S. It is the global optimum and is always positive with an upper bound when the 
formation is non-collinear. 

In a formation system, when a set of agents equipped with sensors is deployed within a 
neighborhood of the desired shape specified by the shape vector S{G), (22) helps us to decide 
the exact final geometry that requires a small range of transformations from eg, and the control law 
drives the agents approach this optimal geometry. 



5. FORMATION CONTROL UNDER TIME- VARYING SCALE FUNCTION 

As mentioned previously, there are two kinds of strategies to find an appropriate shape scale one 
of which is to determine an optimal value a priori and set it constant during the entire process, as 
discussed in the previous section. Another more intelligent strategy is to consider the time-varying 
function s that adjusts the final scale online. This allows us to evaluate the resemblance of the 
geometry with respect to the desired shape more objective. 

5.7. Formations with three agents 

Triangular formations with three agents interconnected with one another are the most fundamental 
pattern in formation systems, and thus are embraced as the starting point in many literatures, as for 
example in [3, 27, 28]. Here we will also start with this simple and typical case and then further 
extend the results into multiple {n > 3) agents systems. 

Under the fixed-structured control law (17), the dynamics of the formation system in the edge 
space is 

e = Hu = -HR{efM{ef[r{e) - S(e)5] (25) 

The control law w is a function of both s(e) and e, and e in .5(e) is also determined by u, which 
means u and s(e) are highly coupled. This makes the solution to (18) becomes complex and the 
problem may not be solvable exactly. 

Alternatively, we would like to seek for a function s(e) for the following problem: 
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Problem 5.1 

Find a trajectory for s e C(E), which is an explicit function of edge e, such that 



J„(eo,u(s(e),e),s(e)) < Jc{{eQ),u{sc,e), Sc) 



for all Sc G 



Instead of concentrating on the complex optimization problem (18), we suggest to design an 
adjusting rule for the scale such that the formation system under the control law always exhibits 
better cooperative performance than the case with a constant scale. 

Consider the equation 

dS 

which has the equivalent form of 







(26) 



dL 



2[r{ef - S{e)S^]R{e)R{efS 



(27) 



where L is the loss function of Jy. By using the fact 



and the cosine law 



e,- e,- = e; e,- cosfc 



1 



\\eMeA\cos{e,,)^-{\\e,r + \\e,r-\\e,r) 



where e^, Cj and form an triangle, we obtain 



dL 



2[r(e) - S{e)SfDr{e) 



where 



D = 



S2 + S3 - 4S1 S2 - S3 S3 - S2 

Si - S3 Si + S3 - 4S2 S3 - Si 

Si - S2 S2 - Si Si + S2 - 4S3 



If we let ^ = 0, a trajectory of s(e) is then 

s*(e) 



(28) 



(29) 



(30) 



S^Dr{e) ■ SD 

and next we prove that the cost function J„ with the scale (30) is consistently smaller than Jc. 
Theorem 5.1 

Given the same initial geometry eo and the same desired shape S, the inequality 

J„(eo,M(s*(e),e),s*(e)) < Jc((eo), u(sc, e), s^) 

with s* given in (30) always holds true for arbitrary Sc e M+. The equality is satisfied if and only if 
eo e {e\S). 

Proof 

Substituting s* into J„, the difference of J„ and Jc is 



((r - rSfRR^{r - %* S) - (r - s^SfRR^ir - s^S)) dr 

[(r' - sl)S^ + 2(s, - S*)r'^]RR^ SdT 

(s* - Sc){S*S'^ - + ScS'^ - r'^)RR^SdT 



(31) 
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Recall the characters of s*. 



[r^ - s*S'^]RR^S = 



Based on the expression of s* in (30), 



According to (32) and (33), equation (31) has the simplified form of 

1 



(32) 



(33) 



Jy Jc 







The positiveness of sd is guaranteed according to the equality of 



Dr = RR' S 



which further yields 



Jy-Jc= / ((r' - ScS' )DrYdT < 0,Vsc > 

Jo SD 



where equality holds if and only if Sc 



iie,ir 



■,Vie [l,2,3],i.e., eo S {e|5}. 



(34) 



□ 



Even when Sc ^ s^, the conclusion of J„ having a smaller value still holds true, which indicates 
that better cooperative performance is always observed on J„. 

Theorem 5.2 

The triangular formation system (25) is exponentially stable and converges to the invariant set 

le = {e e ImH : r(e) - s*S = 0} if 



M{e) = sjjh - SDSr{ef{D'^ + D) + snSS' D 



(35) 



with parameters D and sd,sn given in (29) and (30) respectively, and s J is the stable value of the 
scale function s(e). 

Before giving the proof to Theorem 5.2, we first propose the following lemma 
Lemma 5.1 

Matrix A/(e), e G E in (35) is a singular matrix if and only if r(e) = kS. 
Proof 

Let Q be the transformation matrix such that 

QS = [si 0] ^ 
Left multiplying matrix Af(e) by Q yields 



QM{e) = sllQ - SD 



r{eY{D' +D)+SN 



D 



Sd - Pi -P2 ~P3 
■2 

,2 



S2 „2 

Si -D "D 



D 



(36) 



where 
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and dij is the elements of matrix D. Matrix M (e) is of full rank if and only if the diagonalize matrix 

diag(m, s|,, s|)) with 

3 

i=2 ^ 

consists of only nonzero diagonal entries, that is m 7^ or equivalently, 

3 

^ sls^ (37) 

Recall (36), if we consider ^(siPi) as the inner product of the two vectors p = [pi p2 paj^and 
S, we obtain 

3 

^{s,pi) = SDSir'^iD'^ + D)S - SNSiS'^DS (38) 

i=l 

Substituting sd and sn given in (30) into (37) and by some trivial calculations, we conclude that 
the necessary and sufficient condition for M (e) being a singular matrix is 

S^Drr'^DS = r^DrS^DS (39) 

which is satisfied if and only if ?-(e) = kS. □ 

Proof of Theorem 5.2 

Consider the positive semidefinite function 

Vie) = [r(e) - S*(e)5]^[r(e) - S*ie)S] (40) 
and its partial derivative with respect to e 

oe oe 

^2[A{e)-—S^Me)-S{e)S] (41) 



The partial derivative ^ is calculated by first solving 



de 
and 



- A{e){D^ + D)r{e) 



Nie) (42) 



de 

which then yield 

dS* _ SDA{e){D^ + £>)r(e) - SNAie)D^S 
de sjj 

Hence the derivative of V{e) with respect to t is 

dt ^ ' ^ de ' dt 

= -2[r(e) - S*(e)5]^[A(e) - N{e)S^f HH^ A(e)M{ef[r{e) - S*{e)S] (43) 

When 

M{e) = slh - SDSr{ef{D^ + D) + snSS^D (44) 
the derivative of V{e) in (43) is negatively semi-definite with the expression 



V{e) = ~^[rief - S*{e)S^]M{e)A{ef H A{e)M{ef[r{e) - S*{e)S] (45) 
4 
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Indeed, V{e) is a valid Lyapunov function candidate. 

For the autonomous system when the derivative of the candidate Lyapunov function is negative 
semi-definite, the asymptotic stability is concluded based on the powerful invariant set theory. 

For the negative semi-definite function V{e), there is an invariant set 

= {ee ImH : V{e) <c,ce M+} 
The set of points in flc where V{e) = satisfies both conditions 

S'^Dr{e) ^ (46) 

and 

i/^A(e)M(e)^[r(e) - S*(e)5] = (47) 

where condition (46) is always true under Assumption 2. 1 . 

When the three agents are connected over the graph shown in Fig. 4(b), matrix iJ^A(e) G M^^^ 
has rank 3 for all e = Hz € E. 

In order to find the largest invariant set, the singularity of matrix A/(e) is crucial to the asymptotic 
stability. As pointed out by Lemma 5.1, M (e) is a full rank matrix when r(e) ^ kS. Thus equation 
(47) is satisfied if and only if there exist e/ such that r(e/) = s*{ef)S. Thus 

le = {e e ImH : r(e) - S}S = 0} (48) 

where = s* (e/) is the largest invariant set for dynamic system (25). 

If we let e being the smallest eigenvalue of RMM'^R^ during the entire convergence, the 
derivative of Vie) is bounded by 

V{e)<~^\\r{e)^~s{B)~Sr:^-e 

which further yields V(e) < F(eo)e~*. According to some trivial calculations, we conclude that 
||r(e) — s(e)5|| exponentially converges to zero. □ 

According to le, once the formation system forms a geometry in {els'}, it stays there from then 
on. 

Equation (30) is a nonlinear map s G C(E) : E — > M where given an assigned shape S, the initial 
geometry gq in the nonlinear control law (30) uniquely determines the stable scale s^ . However, due 
to the nonlinearity, it is difficult to predict the final stable value s^. 

On the other hand, although the exact value of is what we are seeking for, we would like to 
discuss the controllability of the algorithm when the scale is expected to converge to some arbitrary 
fixed value. In such a case, the problem is recast into a general formation control problem with a 
specified desired geometry, which is explored in quite a few works, e.g., [29]. However, we believe 
it is still necessary to make this extension so as to broaden the applications of the algorithm. This 
problem is covered in Subsection 5.3 after we extend the nonlinear control law to multiple(n > 3) 
agents case. 

5.2. Formation with multiple agents 

Some of related literatures concerning formation control were restricted to three agents[7, 20] and 
left the multiagents case as the future work. Extending algorithms into multiple agents case would 
have to deal with the complexity issue where the primary one is the selection of the underlying 
graph. A graph with three nodes connected with each other is a quite special case: it is a complete 
graph, a minimally rigid graph and a ring graph. During the exposition of Theorem 5.2, based on 
the cosine law, this particular property of the three nodes ensures the compact form of the partial 
derivative of the value function L. However, when the number of agents exceeds three, the cosine 
law dose not always applies. 

In order to obtain the nonlinear control law as in three agents formations, an intuitive idea is to 
adopt triangle as the basic unit of the underlying graph. We define the triangular complement of a 
graph which would lead to some interesting and convenient results. 
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(a) Gi 



(b) G2 



(c) Gs 




(d) Gi 



Figure 5. Graphs and their triangular complement graphs shown with dashed lines. Gi and G2 are minimally 
rigid graphs, G3 is only a connected graph and G4 is a globally rigid graph. 



Definition 5.1 

The triangular complement of a graph G = (y, is a graph G' = {V, E') with the same vertex set 
as G and node i are connected to node j in G" if and only if the minimal distance between i, j in G 
are two. The graph sum Ga = G + G' has vertex set V and edges ^ EU E'. 

When the triangular complement graph is added to the minimally rigid graph, its edges are labeled 
from \E\ + 1 to \E\ + \E'\. 



Corllary 5.1 

The graph sum Ga 



G + G' equals to G^ 



For the definition of G^, please refer to, for example, [24, 30]. 

The triangular complement graph G' contains the third edges that constitute triangles with the 
neighboring edges in G, as shown in Fig. 5(a) and Fig. 5(b) where the solid lines are edges in G and 
the dashed lines belong to G'. However, the neighboring edges from G and G' respectively do not 
necessarily have a third edge in Ga that form a triangle, as shown in Fig. 5(c). 

It is not necessarily true that Ga, or equivalently G^, being a complete graph even when G is 
minimally rigid or globally rigid, as for instance the situation in Fig. 5(d) where the length between 
node 4 and node 1 is greater than 2. That is the reason we name it triangular complement graph 
rather than the general complement graph as in [24]. 

The three edges e^, and e-y in Ga that form a triangle is denoted by Ay-y. We have made the 
assumption in the preliminary that each agent has the knowledge of the coordinates of its neighbors, 
thus the agent that is adjacent to and Cj in G is able to calculate the coordinates of the edges 
in G', i.e., e'^ = ei + Cj or e'^ = Ci — Cj for A^^. 

For multiple agents case, the parallel form of matrix D in (29) is denoted by Z)(Ga) G 
j^IBaIxI^aI with entries 







4s, , i = j 



,Aij^,i,j £ E,j £ E 
,Aij^,i,j £ E,-f £ E' 
, Ay^,i,7 e E,j £ E' 
, others 



If we define an expended shape vector S ~ \S\ 0] £ RI^^I and similarly r(e) = [r(e); r'(e)], e = 
[e; e'] where r'(e), the norm of edges in G', is calculated by the corresponding agent using local 
coordinates of the other two edges in G, and consequently, similar to (30) the trajectory of the scale 
function in terms of e is 

sd 



'(e) 



and 



ds 



N 



de 



S^Df{e) 



A{e){D + D^)f{e) 



(49) 



Copyright © 2010 John Wiley & Sons, Ltd. 
Prepared using rncauth.cis 



Int. J. Robust. Nonlinear Control (2010) 
DOI: 10.1002/mc 



CONTROL OF MULTI-AGENT FORMATIONS WITH ONLY SHAPE CONSTRAINTS 



15 



where A(e) 



df{e) 

de ~ 



dsN 

de 

[A(e) A'(e)] e M^l^ 



A(e)^^^ 



I . This further yields 



A/(e) = rsl [hn-s 0] - SDSf'^{e){D^ + D) + snSS^D 



(50) 



where H is still the oriented incidence matrix of G. 
The derivative of the Lyapunov function (40) is then 



V{e) = -^[r(e)^ - s{e)S^]M{e)A{ef HH^ kie)M{ef[r{e) - s{e)S] 



(51) 



Theorem 5.3 

The formation system 



e = 



(52) 



over a minimally rigid graph is exponentially stable and converges to the largest invariant set 1^ in 
(48) if s* (e) and M are given in (49) and (50) respectively. 

PROOF 

The first part of the stability proof is identical to that of three agents situation. When rt > 4, for a 
minimally rigid graph we have the similar results that rankA/ (e) = 2?! — 3 if and only if r (e) = kS, 
and it is also trivial that H^A{e)M^ is of rank 2\V\ — 3. Following the proof of Theorem 5.2 
we conclude that the largest invariant set is Zg in (48), which indicates that the formation system 
converges to the desired shape at some scale s / for a sufficiently small a. 

The proof of exponentially convergence is consistent to that of three agents case and is omitted 
here. □ 



When we considers only three agents in a formation system, the underlying graph is a globally rigid 
one and a minimally rigid one simultaneously, thus the requirements on the initial realization is 
relaxed. However for system with up to four agents, this privilege dose not holds true. Thus it is 
required that the initial geometry gq G H^, and Remark 4.1 applies. 



If we look at [r(e) — s*(e)5] in the control law, we require only a local coordinate for each node 
rather than a global one. The reason is that in the control law, we only concern with the relative 
distance between two agents, as represented by vector 7'(e). On the other hand, in order to calculate 
r'(e), local coordinates of two neighboring edges would be enough as well. However, for the rigidity 
matrix ^(e) = A{e)'^H, it requires the relative coordinates in a common reference frame. So for 
convenience, we assign a global coordinate for the formation system. 

With the time-varying scale function s*, the desired geometry s(e/) is adjusted according to 
the current geometry. Equation (49) is a nonlinear mapping s £ C(E) : E — > M where the initial 
condition eo uniquely determines the stable scale for the prescribed shape S. The scale function 
s* would lead to a bounded scale and ensure a relatively small cost value. This performance is 
observed in the experiments in Section 7. 

5.3. Controllability of the multi-agent formation system 

The aforementioned nonlinear functions s* and s* put us in a blind position about the exact side 
lengths when agents get stabilized, and thus restricts the applications of the algorithms. For instance, 
in the task of payload transport, the desired geometry is constrained within a certain area determined 
by the cargo. Formation that shrinks to some geometry with a relatively small scale around the center 
of gravity may result in a sensitive balance system and a sparse formation where agents locate at the 
edge of the cargo may easily failed. 



Remark 5. 1 



Remark 5.2 
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In order to drive the formation system to converge to an assigned geometry that belongs to {elS*}, 
we add an additional control gain 11 to the nonlinear control law 

z = -UH'^A{e)M{ef[r{e) - s*{e)S] (53) 

where e G E, z e Z and 11 = diag(ai , 02, . . . , a2„). The edge and the state of each agent that evolve 
along (53) are denoted by e and z respectively. 

The weight factor adjusts the convergence rate of each edge and thus tunes the stable value e/ 
and s*(e/), and we will prove that the formation system under control law (53) is controllable. 

Theorem 5.4 

Given a desired geometry e/ in {els'}, there exists 11 satisfying > 0, Vi e [1, 2n] in (53) such that 
a formation system over a minimally rigid underlying graph exponentially converges to e/ given 
that eo e r^cr. 

PROOF 

We prove the theorem by finding the appropriate 11 with respect to A such that r(e) — > \S. The 
procedure could be carried out by taking the original system (25) as a reference system. 

Assume r(e) — > s*(e/)S' and r(e) — > s*(e/)S' where s*(e/) = A, and gq = gq. Let k = 

Apparently, e = iJllz. Integrating on each side of the equation yields 

e/-eo = i/n(z/ -zo) (54) 

The condition that r(e) — ks*S is equivalent to, for each edge vector e^, 

ef^^kR{e)ef^+p, (55) 

with vector p = [pi] e E. Substituting (55) into (54) we obtain 

HUizf -zo) = kR{9)Hzf -ea + p (56) 

where R{9) is a block diagonal matrix with 2x2 identical diagonals R{9). In order to analysis the 
solution of at, (56) could be rewritten into a standard linear matrix equation with respect to ai 



FA(Az) 



ai 

0.211 



^ kR{9)Hzf -eo + p 

^kO{zf)-eo + p (57) 

where A(Az) = diag(z/. - zq,). 

Noting that for a minimally rigid graph, rank (7?) = 2?! — 2, i.e. dim(ker(//)) = 2. On the other 
hand, rank(O) = 2(2n — 3). We can always find a set of positive numbers at in (57) by choosing 
appropriate p such that the number of the nonzero entries of the right hand side vector is less than 
2n- 2. 

With the positive control gain 11, the stability of the formation system under the advanced control 
law (53) could be proved along the same line as Theorem 5.3, which finishes the proof. □ 

Remark 5.3 

In order to ensure the convergence to the desired shape, restrictions on the initial conditions, i.e.. 
Remark 4.1 remain applies. 

Recall Theorem 5.1, under the endpoint constraints — A, the control law (53) still inherits the 
suboptimality of Jv\e=s' with respect to Jc. 
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The existence of the positive gain 11 could also be validated by the geometric representation of 
(57). Condition (57) is satisfied if and only if for all m e \Ea \, 



0.21-1 









a2j-i 






0-2] 



(58) 



where Az^ = z/ . — zoi- Equation (58) determines the adjacency of vectors in Fig. 6. According to 
the triangle inequality, 

d2 — di - di, < di < di + d2 + d^ 



where di 



zo,)||, c?4 = Asm and k 



diag(a2i-i,a2i). 
> 0,Vii e 



By positioning vector e/^ on the upper right side of eo„, it is always guaranteed that U 

The discussion on the controllability allows the algorithms to be applied to situation that requires 
the switching of the geometry's scale during the mission. For example when underwater vehicles are 
mapping out oceanbed[31], the scale of the formation is adjusted online to decrease the interpolation 
error. 

As stated before, this special problem we considered above falls into to the general formation 
control category where the optimization is carried out under the constraint of a fixed geometry. 
However those existing results mainly focus purely on minimal energy expenditure[29] rather than 
the geometrical performance during the process. In our research the cost function is carefully 
designed so as to have the group of agents exhibits prominent geometrical performance during 
convergence. 

In reality, the final scale should be restrained within an interval. Generally, the upper bound 
could be the communication range of agents, and for lower bound, the collisions of agents should 
be taken into account. 

In this section, motivated by the fact that a scale being adjusted online may result in better 
cooperative performance, we found a time-varying scale function in terms of the edge vector e that 
further reduces the global minimum of system with a constant scale. By introducing the triangular 
complement graph, we derived a compact form of the nonlinear control law for multiple agents. 
With the additional control gain, the nonlinear control law is also applicative to general formation 
control problems with fixed final geometry. 



6. GEOMETRICAL PERFORMANCE IN SENSOR-TARGET LOCALIZATIONS 

The localization of target in sensor networks is always carried out by a fleet of three UAVs in 
triangle. Each of the UAVs is equipped with sensors that gather information of the target based on 
bearing measurements[32], range measurements[33] or scan measurements[34]. A lot of literatures 
are devoted to the exploit of the sensors positioning strategy as it is strongly related to the 
localization performance. Based on Fisher information matrix, the pioneering work demonstrated 
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(a) Equilateral (b) Isosceles (c) Scalene 



Figure 7. Optimal triangles for bearing-only sensor-target localization and a normal triangle as shown in 

color blue 



in [16] proved that sensors in a equilateral triangle provide the minimal variance estimation of the 
target. 

Consider the special scenario where sensors (or UAVs that are equipped with sensors) are 
deployed on a circle of radius r around the target. When r is sufficiently large such that the distances 
from the target to the three sensors could be considered as being constant during the entire formation 
attainment process, one of the main results in [16] could be restated specifically as 

Lemma 6.1 

Consider angle-based bearing-only localization with three sensors. Assume the distance between 
sensor i and the target, denoted by r^, satisfies = r,\/i ~ 1, 2, 3. Then the variance estimation of 
the target position is minimized if the triangle formed by the three sensors satisfies 

Oi2 = 6'i3 = ^ arccos(-i) 

023 = 27r - - Ou (59) 

where 9ij e [0, tt] is the angle subtended at the target by two sensors i and j. Moreover, reflecting a 
sensor about the target position does not affects the optimality of the geometry. 

When the distances between sensors and the target are congruent, the optimal geometries 
generated from (59) have only angles constrains and are divided into two subsets where geometries 
in each of them are similar ones. Examples of the optimal geometries in the two subsets are shown 
in Fig. 7(a) and Fig. 7(b) respectively. For situations in Fig. 7(a), any equilateral triangles with the 
target locate at the geometry center are considered to be the optimal deployment of sensors while 
irrespective of their exact sizes. Thus here we focus on this optimal case to exploit the relationship 
between the variance estimation of the target and the resemblance of a geometry with respect to the 
equilateral triangle. 

Consider a target that lies close to an equilateral triangle whose angles are denoted by 6[2, and 
6*23 respectively, as shown in Fig. 7(c). Without lose of generality, assume > > 9[^- Then for 
simplicity, the difference between a shape with respect to the equilateral triangle could be measured 
by 

5-' = Ai + A2 :^ \e[2 -0[,\ + \e'2, - 0[2\ (60) 

A geometry with a larger S has a higher degree of similarity to a equilateral triangle. 

The variance estimation of the target position measured by the sensors are evaluated by the 
determinant of the Fisher information matrix I{6). Under constraints (59), the determinant of I{6) 
achieves its maximum of[16] 

det(/(r))^i, 5:^^-1^ (61) 
where a is the congruent error variance of sensors. 
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For a scalene triangle with angles 6[j , the difference between the determinant values of dot {I {9* ) ) 
and det(/ (61')) is 

A = ^(cos0^3 cos(0'i2 - 9[,) + cos0'i3 cos{0[^ - 0^3) + COS0'i2(0^3 - ^^3)) (62) 
r (T 

The following theorem shows how 6 in (60) affects the localization accuracy. 
Theorem 6.1 

The following two conditions are true if 9[;^ > f . 

i) . when A2 is constant, A increases as Ai increases; 

ii) . when Ai is constant, A increases as A2 increases. 

PROOF 

dA 2 2 2 2 

-(2sin-(27r - A2 - 2Ai) - sin-(27r - A2 + Ai)) - sin-(27r + 2A2 + Ai)) (63) 



dAi 3' 3' 3' " 3 

Similarly, 

(9A 2 2 2 2 

-(sin -(27r - A2 + Ai) + sin -(27r - A2 - 2Ai)) - 2sin -(27r + 2A2 + Ai)) (64) 



aA2 3' 3' ' 3' " 3 

The sufficient conditions for > and > are 

A2 + 2Ai < I (65) 

when Ai > A2, 

< A2 - Ai < |, 2Ai + A2 < I (66) 

when Ai < A2, and A < n/6 when Ai = A2 = A. Thus irrespective of the relationship between 
^>Oand^ 



Ai and A2, > and -M^- > are sufficiently true if 



< A2 - Ai < I 

and 

< 2Ai + A2 < |. 

or equivalently, 



7T 

^23 + ^13 - 26''i3 < - 

2^23 - ^'12 - ^'13 < f (67) 



Thus under the assumption that ^23 > ^12 > ^13' inequality 

is the sufficient condition to i) and ii). □ 

It can be proved with some trivial calculation that the DOS defined in (9) is positively monotonic 
to 5~^, that is 

Corllary 6. 1 

In bearing-only sensor-target localization with three sensors, assume the smallest angle that is 
subtended by two sensors at the target is greater than ^. Then the three sensors provides better 
estimation of the target location if the DOS of the triangle to the equilateral triangle is higher. 
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Generally in UAV localizations, the three UAVs are set off from certain locations and are 
commanded to fly towards the destination separately. Localization of the target is carried out after 
they attain the desired geometry at the destination. However, instead of relying completely on 
the final attainment of the formation, according to Theorem 6.1, we suggest that if we can take 
the formation performance J(eo,w, 9) into account during attainment, the geometries that are 
resemble to the optimal one can provide pre-measurements of the target location before arriving 
at the destination. Strategies could be made based on those forecasted data and the executing time 
could be cut down if the localization is not expected to be highly accurate. 

Simulations are given at the end of Section 7 to show the improvement of the localization 
capability when the control law (17) with s(e) = s*{e) is applied. 



7. EXAMPLES AND SIMULATIONS 

In order to validate the effectiveness and the system performance of the proposed nonlinear control 
laws and the superiority of the time-varying scale function, we compare system performance under 
the control laws introduced in Section 4 and Section 5. 

For multiple agents, the underlying minimally rigid graph is not unique, which inspires us to 
explore how the topology affects the system performance. Recall that a triangular complement graph 
is defined when applying the control law to multiple agents, we suggest to categorize the minimally 
rigid graphs by the number of edges in their triangular complement graphs, and then analysis their 
corresponding performance. 

Apart from comparing the cost values, we also observe the maximal and total distance agents 
travel. These might be important in certain scenarios although they are not our primary concerns in 
this research. However, this observation could be a starting point for the future work. 

The cooperative performance and its relationship to the cost function is illustrated in an intuitive 
way to further demonstrate the feature of the cost function. 

Conclusions and conjectures are drawn from the results on how the underlying topology and the 
initial realizations are related to the cooperative performance. 

7.1. The scales of geometries and the performance 

We show the energy saving of a formation system under the optimal invariant scale s* and 
compare it with other invariant scales. Consider a formation system consists of four agents that 
are initialized at zo = [0; 0; 1; 0; 1; 2; 0; 2] over a minimally rigid graph Ga in Fig. 8(a). The desired 
shape corresponds to Ga is measured hy S = [3; 3; 3; 2; 3]. The time-invariant scales are scanned 
from 0.1 to 0.9 at step length 0.1 and the cost value at different Sc are shown in Fig. 9(a). The 
data when — 0.1, 0.3 and 0.9 are recorded in Table I. According to Fig. 9(a), the optimal time- 
invariant scale is s* ~ 0.5 which is exactly the value calculated from (22), and the optimal cost value 
is J* = 2.1249, as shown in Table I. The formations when s = 0.5 and s = 0.9 are shown in Fig. 
9(b) and Fig. 9(c) respectively. This verifies our conclusion that (22) helps to pick up the optimal 
geometry in {e\S} and the control law (15) drives the formation system attain this geometry when 
initialized within a qualified neighborhood. 

Moreover, we compare the differences between the cost functions Jc and Jy. The data in Table I 
infers that when converge to the same geometry, formation system with time-varying scale s*(e) 
has less cost value than system with constant scale, which is measured by 1.7402 and 2.1249 
respectively. This result verifies the advantages that are brought by s* (e) in the nonlinear formation 
system. 

We further observe the distance each agent travels during the process and record the data in the 
table. According to the data, the total distance the four agents travel has a relatively smaller value 
of 1.8422 when the scale is a time-varying function. On the other hand, if we look at the maximal 
distance of the four agents travel at different scales (as distinguished by underlines), agent 4 has the 
smallest traveling distance of 0.6003 when Sc = 0.5. 
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Figure 8. Two different graphs with the same number of triangular complement edges 




(a) The cost value Jc (b) Sc = 0.5 (c) Sc = 0.5 



Figure 9. Formation system under time-invariant scale 
Table I. Time-varying VS. Time-invariant scale under Ga 



Initial Conditions n = 4; zo = [0; 0; 1; 0; 1: 2; 0; 2]; S = |3; 3; 3; 2: 3] 






./ 


L: Length of each route 


Sum{L) 


Invariant scale 


0.1 
0.3 
0.9 
0.5 


5.5227 
2.8944 
5.1248 
2.1249 


r 0.5167 0.7831 0.4686 0.83181 
10.4306 0.5534 0.3297 0.67001 
10.9559 0.6111 0.934C 0.63311 
10.5775 0.4608 0.4933 0.60031 


2.6002 
1.9837 
3.1347 
2.1319 


Vaiying scale 


0.3 


1.7402 


[0.3898 0.5190 0.2814 0.65191 


1.8422 



7.2. The Topology, the initial geometry and the cooperative performance 

In the category of minimally rigid graphs, according to their triangular complement graphs, they 
could be divided into different subsets where graphs G that belong to the same subset have the same 
number of edges in G^, i.e., \E'\ of G' are identical. In this subsection, parallel experiments are 
carried out over graphs that are within one subset and between different subsets respectively. 

For comparison, the four agents in the previous experiment are assigned with another minimally 
rigid graph shown in Fig. 8(b), which also has one edge in its triangular complement graph. The 
initial condition and the desired shape are supposed to be the same as that of Ga- Note that for 
different underlying graphs, the shape vector 5* differs as well. When applying the nonlinear control 
law (52) on systems interconnected over Gb, the scale converges to 0.3563. The cost value of the 
system over Gb is 4.2120, compared to that of 1.7402 for Ga- The data is recorded in Table 11. Fig. 
10 demonstrates the geometry of the agents system and the trajectory of the scale s* (e). The circles 
represent their initial positions and the bold blue lines are their final realization. 

Apart from the cost value. Table 11 also shows that the total distance all agents travel is 1.8766 for 
graph Gb, which is larger than that of Ga- 

Topology affects the system performance in terms of cost value and the sum of lengths each 
node travel. According to the experimental results, Ga should be considered as being better than 
Gb both in cooperative performance and the total traveling distance. Although the sub-optimization 
problem we discussed throughout the paper depends highly on the initial conditions, the fact that Ga 
outperforms Gb stays true for all cases we tested with a large number of different initial realizations. 

We further investigate another situation where two underlying graphs have different numbers of 
triangular complement edges. We consider six agents over four different minimally rigid graphs, as 
shown in Fig. 11. The trajectories of the formation system are shown in Fig. 12 with experimental 
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Table II. Systems over different underlying graphs with identical \E'\ 



n = 4;zo = |0: 0; 1; 0; 1; 2; 0: 2]; 5(G„) = [3; 3; 3; 2: 3); S(Gi,) = |3; 3; 2; 4 + ^15; 3] 






,/„ 


L: Length of each route 


Su:m{L) 


Ga 
Gi 


0.3159 
0.3563 


1.7402 
4.2120 


10.3898 0.5190 0.2814 0.6-5191 
10.3711 0.5013 0.3705 0.63381 


1.8422 
1.8766 



Value of time-varying scale S 




(a) Trajectories (b) Time-varying scale s*(e) 



Figure 10. Four agents formations and the scale s*(e) over Ga 



(2)Ga,\E'\ = 5 (b) Gi,, IB'I =6 (c)Gc, |E'| = 6 (d) Gd, = 6 

Figure II. Four different graphs with different number of triangular complement edges. The bold lines 
indicate the minimally rigid graphs, and dashed lines are their triangular complement edges 



results recorded in Table III. The curves for the time-varying scale s*(e) over the four graphs are 
demonstrated in Fig. 13. 

A significant difference between Ga and the other three graphs is that Ga only requires 5 
additional edges for its triangular complement graph while the number is 6 for the other three. 
This interesting property explains the differences of he cost values and total traveling distances in 
Table III. Even with different initial realizations zq and Zg that differs on the position of agent 4, 
the cost value under Ga is consistently smaller than that of the other three graphs, as shown in the 
upper part and the bottom part of the table respectively. 

The data cortesponding to the four graphs infer the possibility that the system whose underlying 
graph having a smaller number of triangular complement edges, such as Ga, may exhibit a better 
cooperative performance than the one with more triangular complement edges, such as Gb, Gc and 
Gd- 

On the other hand, the maximal distance the six agents travel, as highlighted with underlines in 
the table, also proves the superiority of graph Ga over the others. The smallest maximal distance 
agents travel is observed in Ga, which helps to prevent the overwhelming of a single agent. This is 
again only a conjecture from the curtent experiment without theoretical proofs, which is an ongoing 
work to this research. 

The DOSs of the four graphs Ga, Gb, Gc and Gd to the desired shape are shown in Fig. 14. The 
solid line, which corresponds to graph Ga, has both a fast convergence speed and stay in a high DOS 
during the process. Although system over Gc achieved the desired shape as fast as the one over Ga 
did, its geometric distance to the desired shape during convergence was much larger. 
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(a) Ga (b) Gb (c) Gc (d) Ga 

Figure 12. Trajectories of six agents interconnected over different graphs 



Value of time-vat7ing scale S 




Figure 13. Scale s*(e) over the four graphs 



Table III. Systems over different underlying graphs where \E'\ differs 



n = 6; S{Ga] = [3.6; 1; 1.01; 0.52; 0.41; 2.61; 2.41; 0.29; 0.89]; 
S{Gi,) = [3.6; 1; 4; 1.01; 0.52; 0.41; 0.29; 0.89; 1.16] 
S(Gc) = [3.6;1;4;1.01;0.52;1.16;2.61;2.89;0.89]; 
S(Grf) = [3.6; 1; 4; 1.01; 0.41; 2; 4.6; 0.52; 1.16] 


zo = 


0.1;0.6;2;1;2;0;0;-1;0.5;0.4;1.5;0.8]; 






./„ 


L'. Length of each route 


Sum{L) 


Ga 

Gft 
Gc 
Grf 


0.5873 
0.5652 
0.5369 
0.5589 


0.6918 

0.7724 
0.9152 
0.9169 


rO.3143 0.2128 0.2214 0.5202 0.4290 0.1411] 
[0.2805 0.1532 0.1737 0.5289 0.4500 0.14881 
10.2900 0.2767 0.1799 0.5628 0.4139 0.27131 
[0.2407 0.1 185 0.2152 0.5305 0.3916 0.1 1891 


1.8388 
1.7351 
1.9946 
1.6154 


zo = 


0.1; 0.6; 2; 1;2;0; -1; 0; 0.5; 0.4; 1.5; 0.8]; 






■h- 


L : Length of each route 


Sum{L) 


Ga 

Gt 

Ga 

Grf 


0.6105 
0.5838 
0.5421 
0.5570 


1.0284 

1.5533 
1.7603 
2.4951 


[0.5100 0.2428 0.1906 0.7621 0.3985 0.14671 
[0.6338 0.4744 0.5584 0.7953 0.3977 0.34891 
[0.4980 0.5902 0.4058 0.8065 0.4816 0.40971 
[0.5947 0.2069 0.4649 0.8142 0.3718 0.42631 


2.2507 
3.2086 
3.1918 
2.8788 




Figure 14. The inverse of the geometry's DOS at time t 
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(a) The inverse of the triangles DOS to the equilateral (b) Determinant of the Fisher infonnation matrix 
one 

Figure 15. Formation control in bearing-only sensor-target localization 
7.3. Geometries in sensor-target localization 

A triangle that has a higher DOS to the equilateral one could provide better estimation of the target 
location, as discussed in Section 6. 

We consider three agents initialized at zo = [0; 0; 3; 1.5; 4; 0]. The desired shape is a equilateral 
triangle, which is one of the optimal shapes in bearing-only sensor-target localization. The specialty 
of equilateral triangle For systems with the time-varying scale function and with a constant scale 
respectively, the geometries' DOS during the process are shown in Fig. 15(a). 

The determinant of the Fisher information matrix during the process is calculated in Fig. 15(b). 
The system with a constant scale has consistently smaller degree of similarity to the equilateral 
triangle, and also smaller determinant value, which indicates the variance estimation is relatively 
worse. This validates the conclusion of Corollary 6. 1 . 

8. CONCLUSIONS AND FUTURE WORKS 

For a formation system with a flexible scale but under shape constraints, we discussed the strategies 
of choosing the desired geometries' scale so as to achieve better cooperative performance. In order 
to ensure the exponential stability of the system over a minimally rigid graph, fixed-structured 
nonlinear control laws on the edges and the scale were considered, where two types of scale design 
methods were proposed, namely the time-invariant scale and the time-varying scale function. It was 
proved that a system with the time-varying scale function could further reduce the minimum of the 
cost value when the scale is constant. By defining a triangular complement graph, the algorithm also 
applied to the multiple agents case. The controllability of the formation system was also discussed 
by adjusting the convergence rate of each edge with respect to the reference system. 

These results were validated on various simulations where we compared the cost values of 
systems with constant scale and the time-varying scale function respectively. The experimental 
results also inferred the possibility that the underlying topology with a smaller number of triangular 
complement edges may always cost less during convergence and thus may have better cooperative 
performance. Theoretical proof to this conjecture is still undergoing. Moreover, we also applied the 
control laws in sensor-target localization to show the prominent features of the nonlinear formation 
system we designed. 

The nonlinear dynamics (52) is a centralized control law as s*(e) contains states information of 
every agent in the system rather than local information. Decentralized/distributed algorithms should 
be considered in the future so as to meet the scalability requirements. Moreover, further research 
should focus on eliminating the restriction on the minimally rigid underlying graph. 
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